function draw_trajectory(x1, y1, z1, x2, y2, z2, x3, y3, z3)
    %DrawTrajectory ʵʱ�����������˻��Ĺ켣�㣬�Ӷ���̬չʾ��ӱ任�Ĺ켣�任��
    %   (x,y,z)��ʾ�������˻���ʱ������㣬ע�ⲻͬ�����˻�������ò�ͬ��ɫ��ʾ��
    plot3(x1, y1, z1, '.', 'Color', [1 0 0]);
    hold on;
    plot3(x2, y2, z2, '.', 'Color', [0 1 0]);
    hold on;
    plot3(x3, y3, z3, '.', 'Color', [0 0 1]);
    hold on;
    plot3([x1, x2], [y1, y2], [z1, z2]);
    hold on;
    plot3([x2, x3], [y2, y3], [z2, z3]);
    hold on;
    plot3([x3, x1], [y3, y1], [z3, z1]);
    drawnow; %���»�ͼ��ʵʱ����ͼ���ÿһ���仯
end
